Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- const int stepX = 2;
- const int dirX = 5;
- const int stepY = 3;
- const int dirY = 6;
- const int enPin = 8;
- void setup() {
- pinMode(stepX,OUTPUT);
- pinMode(dirX,OUTPUT);
- pinMode(stepY,OUTPUT);
- pinMode(dirY,OUTPUT);
- pinMode(enPin,OUTPUT);
- }
- void loop() {
- digitalWrite(enPin,LOW);
- digitalWrite(dirX,LOW);
- for(int x = 0; x < 25000; x++) {
- digitalWrite(stepX,HIGH);
- delayMicroseconds(800);
- digitalWrite(stepX,LOW);
- delayMicroseconds(800);
- }
- delay(1000);//01
- digitalWrite(enPin,LOW);
- digitalWrite(dirY,LOW);
- for(int x = 0; x < 1000; x++) {
- digitalWrite(stepY,HIGH);
- delayMicroseconds(800);
- digitalWrite(stepY,LOW);
- delayMicroseconds(800);
- }
- delay(1000);
- digitalWrite(enPin,LOW);
- digitalWrite(dirX,HIGH);
- for(int x = 0; x < 25000; x++) {
- digitalWrite(stepX,HIGH);
- delayMicroseconds(800);
- digitalWrite(stepX,LOW);
- delayMicroseconds(800);
- }
- delay(1000);//02
- digitalWrite(enPin,LOW);
- digitalWrite(dirY,LOW);
- for(int x = 0; x < 1000; x++) {
- digitalWrite(stepY,HIGH);
- delayMicroseconds(800);
- digitalWrite(stepY,LOW);
- delayMicroseconds(800);
- }
- delay(1000);
- digitalWrite(enPin,LOW);
- digitalWrite(dirX,LOW);
- for(int x = 0; x < 25000; x++) {
- digitalWrite(stepX,HIGH);
- delayMicroseconds(800);
- digitalWrite(stepX,LOW);
- delayMicroseconds(800);
- }
- delay(1000);//03
- digitalWrite(enPin,LOW);
- digitalWrite(dirY,LOW);
- for(int x = 0; x < 1000; x++) {
- digitalWrite(stepY,HIGH);
- delayMicroseconds(800);
- digitalWrite(stepY,LOW);
- delayMicroseconds(800);
- }
- delay(1000);
- digitalWrite(enPin,LOW);
- digitalWrite(dirX,HIGH);
- for(int x = 0; x < 25000; x++) {
- digitalWrite(stepX,HIGH);
- delayMicroseconds(800);
- digitalWrite(stepX,LOW);
- delayMicroseconds(800);
- }
- delay(1000);//04
- digitalWrite(enPin,LOW);
- digitalWrite(dirY,LOW);
- for(int x = 0; x < 1000; x++) {
- digitalWrite(stepY,HIGH);
- delayMicroseconds(800);
- digitalWrite(stepY,LOW);
- delayMicroseconds(800);
- }
- delay(1000);
- digitalWrite(enPin,LOW);
- digitalWrite(dirX,LOW);
- for(int x = 0; x < 25000; x++) {
- digitalWrite(stepX,HIGH);
- delayMicroseconds(800);
- digitalWrite(stepX,LOW);
- delayMicroseconds(800);
- }
- delay(1000);//05
- digitalWrite(enPin,LOW);
- digitalWrite(dirY,LOW);
- for(int x = 0; x < 1000; x++) {
- digitalWrite(stepY,HIGH);
- delayMicroseconds(800);
- digitalWrite(stepY,LOW);
- delayMicroseconds(800);
- }
- delay(1000);
- digitalWrite(enPin,LOW);
- digitalWrite(dirX,HIGH);
- for(int x = 0; x < 25000; x++) {
- digitalWrite(stepX,HIGH);
- delayMicroseconds(800);
- digitalWrite(stepX,LOW);
- delayMicroseconds(800);
- }
- delay(1000);//06
- digitalWrite(enPin,LOW);
- digitalWrite(dirY,LOW);
- for(int x = 0; x < 1000; x++) {
- digitalWrite(stepY,HIGH);
- delayMicroseconds(800);
- digitalWrite(stepY,LOW);
- delayMicroseconds(800);
- }
- delay(1000);
- digitalWrite(enPin,LOW);
- digitalWrite(dirX,LOW);
- for(int x = 0; x < 25000; x++) {
- digitalWrite(stepX,HIGH);
- delayMicroseconds(800);
- digitalWrite(stepX,LOW);
- delayMicroseconds(800);
- }
- delay(1000);//07
- digitalWrite(enPin,LOW);
- digitalWrite(dirY,LOW);
- for(int x = 0; x < 1000; x++) {
- digitalWrite(stepY,HIGH);
- delayMicroseconds(800);
- digitalWrite(stepY,LOW);
- delayMicroseconds(800);
- }
- delay(1000);
- digitalWrite(enPin,LOW);
- digitalWrite(dirX,HIGH);
- for(int x = 0; x < 25000; x++) {
- digitalWrite(stepX,HIGH);
- delayMicroseconds(800);
- digitalWrite(stepX,LOW);
- delayMicroseconds(800);
- }
- delay(1000);//08
- digitalWrite(enPin,LOW);
- digitalWrite(dirY,LOW);
- for(int x = 0; x < 1000; x++) {
- digitalWrite(stepY,HIGH);
- delayMicroseconds(800);
- digitalWrite(stepY,LOW);
- delayMicroseconds(800);
- }
- delay(1000);
- digitalWrite(enPin,LOW);
- digitalWrite(dirX,LOW);
- for(int x = 0; x < 25000; x++) {
- digitalWrite(stepX,HIGH);
- delayMicroseconds(800);
- digitalWrite(stepX,LOW);
- delayMicroseconds(800);
- }
- delay(1000);//09
- digitalWrite(enPin,LOW);
- digitalWrite(dirY,LOW);
- for(int x = 0; x < 1000; x++) {
- digitalWrite(stepY,HIGH);
- delayMicroseconds(800);
- digitalWrite(stepY,LOW);
- delayMicroseconds(800);
- }
- delay(1000);
- digitalWrite(enPin,LOW);
- digitalWrite(dirX,HIGH);
- for(int x = 0; x < 25000; x++) {
- digitalWrite(stepX,HIGH);
- delayMicroseconds(800);
- digitalWrite(stepX,LOW);
- delayMicroseconds(800);
- }
- delay(1000);//10
- digitalWrite(enPin,LOW);
- digitalWrite(dirY,LOW);
- for(int x = 0; x < 1000; x++) {
- digitalWrite(stepY,HIGH);
- delayMicroseconds(800);
- digitalWrite(stepY,LOW);
- delayMicroseconds(800);
- }
- delay(1000);
- digitalWrite(enPin,LOW);
- digitalWrite(dirX,LOW);
- for(int x = 0; x < 25000; x++) {
- digitalWrite(stepX,HIGH);
- delayMicroseconds(800);
- digitalWrite(stepX,LOW);
- delayMicroseconds(800);
- }
- delay(1000);//11
- digitalWrite(enPin,LOW);
- digitalWrite(dirY,LOW);
- for(int x = 0; x < 1000; x++) {
- digitalWrite(stepY,HIGH);
- delayMicroseconds(800);
- digitalWrite(stepY,LOW);
- delayMicroseconds(800);
- }
- delay(1000);
- digitalWrite(enPin,LOW);
- digitalWrite(dirX,HIGH);
- for(int x = 0; x < 25000; x++) {
- digitalWrite(stepX,HIGH);
- delayMicroseconds(800);
- digitalWrite(stepX,LOW);
- delayMicroseconds(800);
- }
- delay(1000);//12
- digitalWrite(enPin,LOW);
- digitalWrite(dirY,LOW);
- for(int x = 0; x < 1000; x++) {
- digitalWrite(stepY,HIGH);
- delayMicroseconds(800);
- digitalWrite(stepY,LOW);
- delayMicroseconds(800);
- }
- delay(1000);
- digitalWrite(enPin,LOW);
- digitalWrite(dirX,LOW);
- for(int x = 0; x < 25000; x++) {
- digitalWrite(stepX,HIGH);
- delayMicroseconds(800);
- digitalWrite(stepX,LOW);
- delayMicroseconds(800);
- }
- delay(1000);//13
- digitalWrite(enPin,LOW);
- digitalWrite(dirY,LOW);
- for(int x = 0; x < 1000; x++) {
- digitalWrite(stepY,HIGH);
- delayMicroseconds(800);
- digitalWrite(stepY,LOW);
- delayMicroseconds(800);
- }
- delay(1000);
- digitalWrite(enPin,LOW);
- digitalWrite(dirX,HIGH);
- for(int x = 0; x < 25000; x++) {
- digitalWrite(stepX,HIGH);
- delayMicroseconds(800);
- digitalWrite(stepX,LOW);
- delayMicroseconds(800);
- }
- delay(1000);//14
- digitalWrite(enPin,LOW);
- digitalWrite(dirY,LOW);
- for(int x = 0; x < 1000; x++) {
- digitalWrite(stepY,HIGH);
- delayMicroseconds(800);
- digitalWrite(stepY,LOW);
- delayMicroseconds(800);
- }
- delay(1000);
- digitalWrite(enPin,LOW);
- digitalWrite(dirX,LOW);
- for(int x = 0; x < 25000; x++) {
- digitalWrite(stepX,HIGH);
- delayMicroseconds(800);
- digitalWrite(stepX,LOW);
- delayMicroseconds(800);
- }
- delay(1000);//15
- digitalWrite(enPin,LOW);
- digitalWrite(dirY,LOW);
- for(int x = 0; x < 1000; x++) {
- digitalWrite(stepY,HIGH);
- delayMicroseconds(800);
- digitalWrite(stepY,LOW);
- delayMicroseconds(800);
- }
- delay(1000);
- digitalWrite(enPin,LOW);
- digitalWrite(dirX,HIGH);
- for(int x = 0; x < 25000; x++) {
- digitalWrite(stepX,HIGH);
- delayMicroseconds(800);
- digitalWrite(stepX,LOW);
- delayMicroseconds(800);
- }
- delay(1000);//16
- digitalWrite(enPin,LOW);
- digitalWrite(dirY,LOW);
- for(int x = 0; x < 1000; x++) {
- digitalWrite(stepY,HIGH);
- delayMicroseconds(800);
- digitalWrite(stepY,LOW);
- delayMicroseconds(800);
- }
- delay(1000);
- digitalWrite(enPin,LOW);
- digitalWrite(dirX,LOW);
- for(int x = 0; x < 25000; x++) {
- digitalWrite(stepX,HIGH);
- delayMicroseconds(800);
- digitalWrite(stepX,LOW);
- delayMicroseconds(800);
- }
- delay(1000);//17
- digitalWrite(enPin,LOW);
- digitalWrite(dirY,LOW);
- for(int x = 0; x < 1000; x++) {
- digitalWrite(stepY,HIGH);
- delayMicroseconds(800);
- digitalWrite(stepY,LOW);
- delayMicroseconds(800);
- }
- delay(1000);
- digitalWrite(enPin,LOW);
- digitalWrite(dirX,HIGH);
- for(int x = 0; x < 25000; x++) {
- digitalWrite(stepX,HIGH);
- delayMicroseconds(800);
- digitalWrite(stepX,LOW);
- delayMicroseconds(800);
- }
- delay(1000);//18
- digitalWrite(enPin,LOW);
- digitalWrite(dirY,LOW);
- for(int x = 0; x < 1000; x++) {
- digitalWrite(stepY,HIGH);
- delayMicroseconds(800);
- digitalWrite(stepY,LOW);
- delayMicroseconds(800);
- }
- delay(1000);
- digitalWrite(enPin,LOW);
- digitalWrite(dirX,LOW);
- for(int x = 0; x < 25000; x++) {
- digitalWrite(stepX,HIGH);
- delayMicroseconds(800);
- digitalWrite(stepX,LOW);
- delayMicroseconds(800);
- }
- delay(1000);//19
- digitalWrite(enPin,LOW);
- digitalWrite(dirY,LOW);
- for(int x = 0; x < 1000; x++) {
- digitalWrite(stepY,HIGH);
- delayMicroseconds(800);
- digitalWrite(stepY,LOW);
- delayMicroseconds(800);
- }
- delay(1000);
- digitalWrite(enPin,LOW);
- digitalWrite(dirX,HIGH);
- for(int x = 0; x < 25000; x++) {
- digitalWrite(stepX,HIGH);
- delayMicroseconds(800);
- digitalWrite(stepX,LOW);
- delayMicroseconds(800);
- }
- delay(1000);//20
- digitalWrite(enPin,LOW);
- digitalWrite(dirY,LOW);
- for(int x = 0; x < 1000; x++) {
- digitalWrite(stepY,HIGH);
- delayMicroseconds(800);
- digitalWrite(stepY,LOW);
- delayMicroseconds(800);
- }
- delay(1000);
- digitalWrite(enPin,LOW);
- digitalWrite(dirX,LOW);
- for(int x = 0; x < 25000; x++) {
- digitalWrite(stepX,HIGH);
- delayMicroseconds(800);
- digitalWrite(stepX,LOW);
- delayMicroseconds(800);
- }
- delay(1000);//21
- digitalWrite(enPin,LOW);
- digitalWrite(dirY,LOW);
- for(int x = 0; x < 1000; x++) {
- digitalWrite(stepY,HIGH);
- delayMicroseconds(800);
- digitalWrite(stepY,LOW);
- delayMicroseconds(800);
- }
- delay(1000);
- digitalWrite(enPin,LOW);
- digitalWrite(dirX,HIGH);
- for(int x = 0; x < 25000; x++) {
- digitalWrite(stepX,HIGH);
- delayMicroseconds(800);
- digitalWrite(stepX,LOW);
- delayMicroseconds(800);
- }
- delay(1000);
- digitalWrite(enPin,LOW);
- digitalWrite(dirY,HIGH);
- for(int x = 0; x < 21000; x++) {
- digitalWrite(stepY,HIGH);
- delayMicroseconds(800);
- digitalWrite(stepY,LOW);
- delayMicroseconds(800);
- }
- delay(1000);
- }
Add Comment
Please, Sign In to add comment